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Motion Planning for Multi-Link Robots 
by Implicit Configuration-Space Tiling* 


Oren Salzmanf Kiril Solovey^ and Dan Halperin^^ 


Abstract — We study the problem of motion-planning for free- 
flying mniti-link robots and develop a sampling-based algorithm 
that is speciflcally tailored for the task. Our approach exploits 
the fact that the set of configurations for vrhich the robot is 
self-collision free is independent of the obstacles or of the exact 
placement of the robot. This allows for decoupling between 
costly self-collision checks on the one hand, which we do 
off-line (and can even be stored permanently on the robot’s 
controller), and collision with obstacles on the other hand, 
which we compute in the query phase. In particular, given a 
specific robot type onr algorithm precomputes a tiling roadmap, 
which efficiently and Implicitly encodes the self-collision free 
(sub-)space over the entire configuration space, where the latter 
can be infinite for that matter. To answer a qnery, which consists 
of a start position, a target region, and a workspace environment, 
we traverse the tiling roadmap while only testing for collisions 
with obstacles. Our algorithm suggests more flexibility than the 
prevailing paradigm in which a precompnted roadmap depends 
both on the robot and on the scenario at hand. We demonstrate 
the effectiveness of our approach on open and closed-chain 
multi-link robots, where in some settings our algorithm is more 
than fifty times faster than commonly used, as well as state-of- 
the-art solutions. 


I. Introduction 

Motion planning is a fundamental problem in robotics. 
In its most basic form, it is concerned with moving a 
robot from start to target while avoiding collisions with 
obstacles. Initial efforts in motion planning have focused 
on designing complete analytical algorithms (see, e.g., Qx 
which aim to construct an explicit representation of the 
free space—the set of collision-free configurations. However, 
with the realization that such approaches are computation¬ 
ally intractable 0, even for relatively-simple settings, the 
interest of the Robotics community has gradually shifted 
to sampling-based techniques for motion planning 0 - 
Such techniques attempt to capture the connectivity of the 
free space by random sampling, and are conceptually simple, 
easy to implement, and remarkably efficient in practical 
settings. As such, they are widely used in practice. Another 
key advantage of these techniques is that they are typically 
described in general terms and can often be applied to a 
wide range of robots and scenarios. However, this also has 
its downsides. Due to the limited reliance of sampling-based 
algorithms on the specific structure of the problem at hand, 
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they tend to overlook unique aspects of the problem, which 
might be exploited to increase the efficiency of such methods. 
For instance, a more careful analysis of the specific problem 
may result in a reduced reliance on collision detection, 
which is often considered to be the bottleneck component 
in sampling-based algorithms. 

In this paper we study the problem of planning the motion 
of a multi-link robot, which consists of multiple rigid links 
connected by a set of joints (see Fig. [TJ. We assume that 
the robot is free flying, i.e., none of its joints are anchored 
to a specific point in the workspace. We describe a novel 
algorithm which exploits the unique structure of the problem. 
Our work is based on the simple observation that the set of 
configurations for which the robot is not in self collision 
is independent of the obstacles or on the exact placement 
of the robot. This allows to eliminate costly self-collision 
checks in the query stage, and to carry them out during 
the preprocessing stage. The novelty comes from the fact 
that preprocessing needs to be carried out once for a given 
type of robot. This is in contrast to prevalent state-of-the- 
art techniques, such as PRM* |j^, where the preprocessed 
structure can only be applied to a particular scenario and 
robot type. In some situations, self-collision checks can be 
as costly as obstacle-collision checks—^particularly in cases 
where the robot consists of many links or when the links 
form a closed chain. Moreover, for robots of the latter 
type, computing local paths is particularly costly as the 
set of collision-free configurations lie on a low-dimensional 
manifold in the configuration space. 

At the heart of our approach is an implicit representation 
of the tiling roadmap, which efficiently represents the space 
of configurations that are self-collision free. In particular, it 
is completely independent of the scenarios in which it can be 
employed. Once a query is given in the form of a scenario—a 
description of the workspace obstacles, a start configuration 
and a target region, the tiling roadmap is traversed using the 
recently-introduced dRRT algorithm ||^. 

While our current work deals with free-flying multi-link 
robots, we hope that it will pave the way to the development 
of similar techniques for various types of robots. This may 
have immediate practical implications: when developing a 
robot for mass production, a preprocessed structure, similar 
to the tiling roadmap, would be embedded directly to the 
hardware of the robot. This has the potential to reduce costly 
self-collision checks when dealing with complex robots. 

The rest of the paper is organized as follows: We start 
by reviewing related work in Section |IIj and continue in 
Section III with an overview of our technique and some 




(a) Tight 


(b) Coiled 


(c) Bricks (CC) 


(d) Gripper 


Fig. 1. Test scenarios. Robot links and anchor points are depicted in solid blue lines and blue circles respectively. The head of the robot (red) needs 
to move to the target region (green circle) while avoiding the obstacles (gray polygons) and self intersection. In (a) and (b) the robot consists of an open 
link chain, whereas in (c) the robot is a closed loop. In (d) the robot’s middle joint (black square) is permanently anchored to a specific point and both 
endpoints need to reach the target region 


preliminary definitions. In Section IV we formally describe 
the tiling roadmap and in Section |V| describe how it should 
be used in order to answer motion-planning queries. We 
discuss the properties of the tiling roadmap in Section [VT| and 
present simulations evaluating our algorithm in Section |vn| 
Finally, Section |VIII| discusses the limitations of our work 
and presents possible future work. 


II. Related work 

A common approach to plan the motion of multi-link 
robots is by sampling-based algorithms Q. While 
sampling-based planners such as PRM |0 or RRT 0 
may be used for some types of multi-link robots, they are 
not suited for planning when the robot is constrained Q. 
Thus, the recent years have seen many works attempt¬ 
ing to sample valid configurations and to compute local 
paths for a variety of multi-link robots differing in the 
dimension of the workspace, the type of joints and the 
constraints on the system Additionally, there have 

been application-specific collision-detection algorithms for 
multi-link robots as collision-detection is a key 

ingredient in the implementation of sampling-based motion¬ 
planning algorithms. 

For protein chains, which are typically modelled as high¬ 
dimensional tree-shaped multi-link robots, sampling-based 
approaches have been used together with an energy function 
which guides the search in space (see, e.g., Addi¬ 

tional applications of motion planning for multi-link robots 
are reconfigurable robots 1251, f2E\ and digital actor p7) . For 
an overview of motion planning and additional applications 
see @. 

Specifically relevant to our work is the recently-introduced 
notion of reachable volumes ||28l-|l30l. The reachable vol¬ 
ume of a multi-link system is the set of points that the end 
effector of the system can reach. The authors show how 
to compute the reachable volume and present a method for 
generating self-collision free configurations using reachable 
volumes. This method is applicable to open and closed-chain 
robots, tree-like robots, and robots that include both loops 
and open chains. Pan et al. HD introduced a motion-planning 


algorithm for articulated models such as multi-link robots, 
which is integrated in an RRT-like framework. 

Our work shares similarities with the work by Han and 
Amato HD’ who studied closed chain system and intro¬ 
duced the kinematics-based probabilistic-roadmap (KBPRM) 
planner. This planner constructs a local PRM roadmap that 
ignores the obstacles and only considers the robot’s kine¬ 
matics. Then, copies of the roadmap are placed in the full 
configuration space and connections are made between the 
copies. Our work builds on several of the ideas of KBPRM. 
Specifically, we also exploit the fact that self-collision free 
configurations can be generated while avoiding obstacles and 
copies of these configurations may be placed together with 
connections in the configuration space. The main difference 
from our work is that the resulting roadmap of KBPRM 
depends on a given workspace environment. Another dif¬ 
ference is that they need to apply rigid-body local planning 
when attempting to connect copies of the preprocessed local 
roadmap. In contrast, the implicitly-defined tiling roadmap 
defined in our work already encodes these precomputed 
self-collision free local plans. Our work also bears some 
resemblance to LazyPRM p2) , which constructs a PRM 
roadmap, but entirely delays collision detection to the query 
stage. 

Sampling-based algorithms are not the only tool used to 
address the problem at hand. There have been attempts to 
study the structure of the configuration space of multi-link 
robots (see, e.g., Hg, 0) or to explicitly construct it (see, 
e.g., 1^-1^). Space-decomposition techniques were used 
to approximate the structure of the configuration space p8|- 
| |40| and efficient graph-search algorithms were used to 
search in a configuration space that was discretized using 
a grid pT] . 

III. Algorithm overview and terminology 

The tiling roadmap Q is an implicitly-represented infinite 
graph that efficiently encodes the space of self-collision free 
configurations of a given robot. The structure of Q depends 
only on the type of the given robot, and is completely 
independent of the workspace scenario in which it can be 































(a) Base configurations (b) Translated configurations of base roadmaps 

Fig. 2. Visualization of base roadmaps for a two-link planar robot, (a) Two base configurations depicted in green and purple. Notice that each 
anchor point is depicted differently: by a circle, a square, or a disc, (b) The three base roadmaps induced by these two base configurations. 


used. Every edge of Q represents a motion in which one 
of the endpoints of the robot’s links remains fixed in space. 
We refer to all such endpoints as anchor A motion 

path induced by Q consists of a sequence of moves in 
which the robot alternates between the fixed anchor points 
in order to make progress. Given a query, which consists 
of a start configuration, a target region, and a workspace 
environment, the tiling roadmap Q is traversed using the 
dRRT Q pathfinding algorithm (see Section |V]l. When a 
configuration or an edge is considered by the pathfinding 
algorithm, it is only checked for collisions with the obstacles. 

We now proceed with a set of definitions that will be 
used in the rest of the paper. Let i? be a multi-link robot 
moving in some workspace W C (where d G {2,3}) 
cluttered with obstacles. The robot H consists of rigid links 
and joints connecting them. For simplicity of the exposition 
of the method, we focus here on robots that are “snake¬ 
like”, i.e., each anchor point connects at most two rotating 
rigid links and there are no loops. Thus, we assume that our 
robot consists of m — 1 rigid links and m anchor points. 
We stress that the technique remains correct for any other 
type of a free-flying multi-link robot (see experiments in 
Section [Vn| . While a configuration of such a robot is usually 
represented by the position p G W of its reference point and 
the angles of the joints, it will be simpler to describe our 
technique while representing a configuration by a collection 
of m points in which describe the coordinates of the 
anchor points. Thus, we define the configuration space of 
the robot to be C := {(pi,... ,Pm) \ Pi G such that the 
lengths of the links are fixed. Given an index 1 ^ j ^ m and 
a point q gR‘^ we denote by Cj{q) := {(pi,... ,Pm) | Pj = 
q,yi ^ j Pi G the set of configurations in which the 
j’th anchor point is q. 

We denote the obstacle-collision free space by C C. 
This is the set of configurations in which the robot does 
not collide with any obstacle. In addition, we denote the 
self-collision free space by C C, which is the set of 
configurations in which no two links of the robot intersecj^ 

*The anchor points are not to be confused with the robot’s joints. A 
snake-like robot with m — 1 links has m — 2 joints but m anchor points. 

^We consider a configuration to be in self collision if (i) a pair of links 
that do not share a joint intersect, or (ii) two consecutive links overlap. 


Finally, we set := and refer to this set as the free 

space. In a similar fashion we define these sets for the case 
where the }’th anchor point of the robot is fixed at g S 
i.e., jf(q),J-/(g),Jj(< 7 )cC,(q). 

Given a configuration C = (ci,..., c^) and a point p G 
let C -hp denote the configuration (ci -hp,..., Cm +p). 
Namely, C -h p is the configuration obtained by computing 
a vector sum of each anchor point with the vector p. We 
say that C -h p is the configuration C translated by p. 
Additionally, for a configuration C, as defined above, and an 
index 1 ^ j ^ m, let j{C) := Cj. Namely, j{C) denotes the 
location of the j’th anchor point of configuration C. Finally, 
let 0 denote the origin of 

IV. Tiling roadmaps 

In this section we formally define the tiling roadmap Q, 
which approximates the self-collision free space . We first 
describe a basic ingredient of the tiling roadmap called base 
roadmaps. We then explain the role of base roadmaps in the 
construction of Q. 

A. Base roadmaps for the anchored robot 

Let := (Cl,..., C„} C be a collection of n 

self-collision free configurations called base configurations, 
which were uniformly and randomly samplecH As the 
name suggests, the vertices of Q will be based upon the 
configurations in In particular, every vertex of Q is 

some translation of a configuration from Conversely, 

for every C G there exist infinitely many points 

S = {si,S 2 ,...} C such that for every s G P the 
configuration s -|- C is a vertex of Q. 

In the next step, we use the configurations in ^base jQ 
generate m roadmaps — one for each anchor point, where the 
jth roadmap represents a collection of configurations, and 
paths between them, in which the robot’s jth anchor point 
is fixed at the origin. More formally, the }th roadmap is 
embedded in Pj{0). For each configuration Ci G and 

every 1 ^ j ^ m, we consider the configuration Cj^i := 

^In this work we only consider uniform sampling for the generation 
of base configurations. However, we do not exclude the possibility that 
more sophisticated sampling scheme will lead to better performance of the 
framework. 
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Fig. 3. The tiling roadmap for a toy example which consists of a robot with a single link, (a) Base roadmap for a single-link robot with 12 base 
configurations chosen at fixed intervals of |. (b)-{d) Iteratively placing the base roadmap on endpoints of the link that are closest to the origin 
(the current placements are highlighted by green circles). 


Ci — j{Ci) which represents the configuration Ci translated 
by —jiCi). Clearly, the jth anchor point of Cj^i coincides 
with the origin. Now, set := {Cy^,..., and note 
that C -Tf (0). See Fig. 

For every index j we construct the base roadmap Gj{0) = 
(V^(0),£'j(0)), where Vj{0) = which can be viewed 

as a PRM roadmap in -F^^(O) constructed over the sam¬ 
ples Vj{0). We compute for each anchored configuration 
Cj^i G a set of k nearest neighbor^ from We 

add an edge Ej{0) between Cj^i and every neighbor if the 
respective local path connecting the two configurations is 
in J-S(o). 

B. Definition of the tiling roadmap 

So far we have explicitly constructed m base roadmaps 
Gi(0),..., where Gj(0) C T^{0). We now show 

that a configuration that is a vertex in one base roadmap, 
can also be viewed as a vertex in the m — 1 remaining 
base roadmaps, after they undergo a certain translation (a 
different translation for each base roadmaps). This yields the 
tiling roadmap Q, in which various translations of the base 
roadmaps are stitched together to form a covering of . 

Given a point p S we use the notation Gj{p) = 
{Vj{p), Ej{p)) to represent the roadmap Gy(0) translated 
by p. We have the following observation, which follows from 
the construction of the base roadmaps. 

Observation 1: Let C be a vertex of Gj{0) for some j. 
Then C is also a vertex of Gji{j'{G)) for any j' j. 
Similarly, if G is a vertex of Gj (p) for some point p G K'^, 
then it is also a vertex of Gy {p + f (G)). 

This observation implies that a robot placed in a config¬ 
uration G of Gj(0) is not restricted to Ej{Q). In particular, 
by viewing G as a vertex of Gji{p + j'{G)), it can perform 
moves in Ty (p-|-j'(G)). This argument can be applied recur¬ 
sively, and implicitly defines the tilling roadmap Q — (V,£). 

We can now proceed to describe the structure of ^ in a 
recursive manner. Initially, Q contains the vertices of the base 
roadmaps Gi(0),..., Gm(0), and the corresponding edges. 

compute a set of nearest neighbors, one needs to define a metric over 
the space. We discuss this issue in Section [vn| 


For every vertex G of Q, and every index j, the neighbors 
of G in Gj{j(C)) are added to Q, as well as the respective 
edges. To visualize the recursive definition of the tiling 
roadmap we examine the simple (self-collision free) case of 
a robot with a single link that was preprocessed with n = 12 
base configurations. Assume that for all base configurations, 
the link’s endpoint is fixed at the origin and the angle of 
the link with the x-axis is chosen at fixed intervals of | (see 
Fig. 3a I. To avoid cluttering the figure, we only visualize part 
of the recursive construction: We place a copy of this base 
roadmap on each of the endpoints of the link (Fig. [Tb| ) and 
iteratively repeat this process for all endpoints around the 
origin (Fig. [3cpd| i. Even for this simple example with only 
12 base configurations we obtain a highly dense tiling of . 


V. Path planning using tiling roadmaps 

Recall that the tilling roadmap Q represents the self¬ 
collision free space of a given robot. We describe how Q 
is used to find a solution, i.e., a path for the robot in 
the fully-free space E, given a query that consists of a 
start configuration S G E, a target region T C E, and 
a workspace environment W. The solution is found by 
(i) adding the start configuration S to each base roadmap 
(together with local paths in this roadmap) and (ii) attempting 
to find a collision-free path from S to T using Q. To 
connect S to each base roadmap we do the following. Let 
Sj := S — j{S) for 1 ^ j ^ m. For every j we connect Sj 
to Gj(0) by selecting a collection of nearest neighbors in 
Gj{0) and applying a local planner which produces paths 
in Ej{0). By definition. S' is a vertex of Q. It remains to 
find a path in Q from S to some other vertex G G V such 
that G G T using a graph-search algorithm. Note that during 
the search each encountered vertex or edge of Q should be 
tested for collision with the obstacles described by W. Also 
note that the vertices and edges are self-collision free by the 
definition of Q. 

To search for a path using the tiling roadmap, one 
may consider employing standard pathfinding algorithms on 
graphs such as A* p2) . However, when the graph is dense, 
and the problem lacks a good heuristic function to guide the 
search. A* (and its many variants) resort to a BFS-like search 























































































Algorithm 1 dRRT 
1: loop 

2: g™d ^ RANDOM_SAMPLE( ) 

3: gnear ^ NEAREST_NEIGHBOR(r, gmd) 

4: gnew ^ DIRECTION_ORACLE(gnear, grad) 

5: if gnew ^ T and VALID(g nean gnew) then 

6 : T.add_vertex(g„ew) 

7: T.add_edge(gnear, gnew) 

8: if gnew € T then 

9: return RETRIEVE_PATH(r, s, T) 


mQrnd 



which is prohibitively costly in terms of running time and 
memory consumption. This is backed-up by our experimental 
work in which A* was unable to make sufficient progress 

on g. 

Instead, our motion-planning algorithm integrates the 
implicitly-represented tiling roadmap Q with a highly- 
efficient pathfinding technique called discrete-RRT 0 
(dRRT). We will refer to our framework as TR-dRRT, where 
“TR” stands for “tiling roadmap”. dRRT (Algorithm [^l is an 
adaptation of the RRT algorithm for the purpose of exploring 
discrete, geometrically-embedded graphs. 

Similarly to its continuous counterpart, dRRT samples a 
random configuration g^d (Alg. line 2), which is not neces¬ 
sarily a vertex of g. Then, it finds the nearest neighbor g„ear 
of gind in the explored portion of g (line 3), which is the 
tree T. The difference lies in line 4. Whereas RRT usually 
expands the tree from gnear towards gmd by generating a path 
that linearly interpolates between the two configurations of g, 
dRRT uses a “direction oracle” which returns a vertex gnew 
such that there is an edge from gnear to gnew in g. Moreover, 
it is guaranteed that the direction gnear gnew is closest to the 
direction gnear gmd among all the edges of g incident to gnear- 
In the next step this edge is checked for obstacle collision 
(line 5). If it is collision free, it is added to T. See a 
visualization in Eig. 

Specifically in TR-dRRT, the direction oracle is imple¬ 
mented in a brute-force manner by going over all the 
neighbors of gnear in g and comparing their directions. This 
set of neighbors is extracted as follows; Recall that for every 
base roadmap Gj, there exists a translation pj such that gnear 
is a vertex of Gj{pj). We take all the neighbors gnear in 
Gjipj), for every j. 

A desirable feature of a sampling-based algorithm is that it 
maintains probabilistic completeness. Namely, as the running 
time of the algorithm increases, the probability that a solution 
is found (assuming one exists) approaches one. Indeed, the 
dRRT algorithm is probabilistically complete (see 0). We 
believe that, under mild assumptions, one can show that the 
TR-dRRT framework is probabilistically complete as well. 
We discuss this issue in the following section. 

VI. Properties of the tiling roadmap 

We discuss some theoretical properties of the tiling 
roadmap. We begin by stating that the tiling roadmap covers 


Fig. 4. dRRT algorithm. The tiling roadmap Q (gray vertices and edges) 
is traversed via subtree T (explored vertices and edges depicted in black). 
Extension is performed by sampling a random configuration qrnd (purple) 
and locating its nearest explored neighbor qncar in T. The direction oracle 
returns a neighbor ijnew of ijnear, which is in the direction of (red). If 
the edge connecting the two configurations is obstacle collision free, gnew 
is added to the explored tree. Figure adapted from j^. 

the collision-free space and providing a proof sketch. Specifi¬ 
cally, we show that for every self-collision free configuration 
Gs € there exist another configuration (7 S V such 
that Gs and G are arbitrarily close as the number of 
samples tends to infinity. We then provide a discussion on 
the additional steps required to show that our method is 
probabilistic complete. 

A. Coverage 

Intuitively, as the number of base configurations grows, 
the tiling roadmap g increases its coverage of . Eor 
simplicity, we consider a planar snake-like robot whose 
configuration space is represented by x 5^ x ... x 5^. We 
use the term “head” to refer to the first anchor point, namely, 
the first endpoint of the first link, and denote by L the length 
of the first link. We will use the standard representation 
of configurations in such a configuration space. Namely, 
we will consider a configuration as a pair {p, 0), where 
p = (x, y) G is the location of the head of the robot and 
0 = ( 6 * 1 ... 0m- 1 ) is a list of angles, where 0^ G is the 
angle between the x-axis and link i. We omit here details 
regarding the metric in order to simplify the presentation. 
Clearly, a rigorous proof will have to take the specific metric 
into consideration. 

We are now ready to state our claims. Eirst, we show that 
given a point q G there is a configuration G G V, where 
C = {p, 0), such that p and g are sufficiently close (in the 
Euclidean distance). This means that the robot’s head can 
achieve coverage of i.e., head coverage. We also require 
angle coverage: given a configuration Gs = (g, 0s) G 
there exists G = (p, 0) G V such that 0 and 0s 
are sufficiently close. Notice that the latter property easily 
follows from the fact that base configurations are uniformly 
sampled from . Combining the two coverage properties, 
we have a full coverage of . 

We show the claim of head coverage using the following 
two steps. 
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Fig. 5. Construction used head coverage, (a) Base configurations C (purple) and C' (green) which are identical except for the first angle 
an = -Kin. The first link (of length L) of the base configurations is depicted using solid lines and only it will be used in (b) and (c). (b) The two 
base roadmaps Gi(0),G2(?') for G, G'. (c) Iteratively constructing the points {y'} which densely lie on the line £' passing through the origin, 
(d) The points {q"} constructed using C, G" (G" is identical to G except for the first angle -a„). (e) The grid of points (black crosses) where 
the head of the robot may lie (step S2) induced by (! (dashed yellow line) and parallel copies of (dashed blue line). Only every other copy of 
I" is depicted to avoid cluttering the figure. 


51 Given a start configuration where the head of the robot 
is at the origin 0, one can construct a straight line (! in 

such that (i) i' intersects 0 and (ii) for every point 
on I', there exists a vertex in the tiling map whose head 
lies on and is close to p up to any desired resolution 
as the number of samples tends to infinity. 

52 The construction in step SI can be used to construct 
two non-parallel lines that span This in turn 
implies that ^ I” induce a grid such that any point in 

is as close as desired to a grid point. 


Sketch of step SI: Set a„ = tt/ti and assume that the fol¬ 
lowing configurations are in the set of n base configurations: 
C = (O,O,02...0m-i) and C = (0, 02 ■ • ■ 

Namely, C is the base configuration where the head of the 
robot is placed at the origin, the first link lies on the x-axis 
and the remaining angles 02 ■ • ■ ^ra-\ are uniformly chosen. 
C is defined in a similar manner, except that the first link has 
a small angle of q:„ with the x-axis. See Fig. 5a Moreover, 
we assume that C, C are neighbors in both base roadmaps 
Gi(0) and G2(0) (namely, the base roadmaps of the first 
two anchor points). Such an assumption is valid since both 
G, C are self-collision free and there exists a self-collision 
free path between the two. Thus, we only assume that they 
are indeed nearest neighbors, which is true for sufficiently 
large value of k, which represents the maximal vertex degree 


in every base roadmap. See Fig. 5b 


We will show that using the assumption that G, G' are 
neighbors in both base roadmaps Gi(0) and G2(0), we 
can construct a series of points {g' | i G N} which lie 
on a line intersecting the origin. These points represent 
locations where the head of the robot may be reached by 
traversing (using exclusively the configurations G, C and 
the base roadmaps Gi(0), G2(0)). Moreover, these points 
get arbitrarily close to one another as the number of samples 
grows (which causes to decrease). The construction is 
fairly simple. Set (/q = 0, is obtained by moving from 
Gi(0) to G^(0) in Gi(0) and then shifting to the roadmap 
G 2 (r) (for the appropriate point r = (Lcosa„,Lsina„)). 
This allows to move from O^ir) to G 2 (r) in G 2 (r). Finally, 


we set q[ to be the head of the robot in configuration 
C 2 {r). This process may be repeated from q[ to obtain 
52 and henceforth. Fig. provides a visualization of the 
construction of the points {q^ \ i G N}. 

Recall that L represents the length of the first link. Using 
basic trigonometry we have that 

ql = {i • L(cosa„ — 1),j • Lsina^). 

Moreover, all such points g' lie on a line I' intersecting the 
origin and every two consecutive points are of (Euclidean) 
distance 

A(n) = ||g'+i - g'||2 = 2Lsin^ = 2Lsin^. 
Clearly lim„_>.oo A(n) = 0. 

Sketch of step S2: The construction of the line in 
step SI was described for a specific pair of configura¬ 
tions G, C. Now, if we consider the configuration G" = 
(0, — 02 ... 0m-i), the same construction holds for the 
pair of configurations G, C" to obtain the points { 9 $^ * G N} 
who all lie on the line i" and for which 

q'l = {i ■ L(cosan — 1), —i • Lsina„). 

Notice that i' and i" are not parallel. Moreover, although the 
construction of I' and I" was shown using the base roadmap 
Gi(0), it holds for any point p where the head of the robot 
may be placed using the tiling roadmap. Specifically, one 
can construct the set of lines {£" | f G N} which are parallel 
to such that for every z G N, intersects i' at the point 
g'. This induces a grid on the plane with growing resolution 
as the number of samples grows. See Fig. 

B. On the probabilistic completeness of the tiling roadmap 

We hope that the analysis presented for coverage will pave 
the way to a probabilistic completeness proof of our method. 
Typical proofs of probabilistic completeness (see, e.g., | |43) , 
| |44| ) rely on two properties of the examined algorithm. 
First, they require that the algorithm will provide coverage 
of the space. Secondly, every two close-by configurations 
need to be connected by an edge in the roadmap and the 











corresponding local path should remain in the proximity 
of the connected configurations. In our case it is unclear 
whether the tiling roadmap abides by the second constraint. 

VII. Evaluation 

We present simulation results evaluating the performance 
of our TR-dRRT framework on various scenarios and types 
of robots in a planar environment. We compare its running 
times with RRT | |45| and RV-RRT | [30) . Our C++ imple¬ 
mentation follows the generic programing paradigm | |46) , 
which exploits the similarity between the behavior of the 
three algorithms in the query stage, and allows them to 
run on a mutual code framework. The only fundamental 
difference lies in the type of the extension method used. 
In particular, whereas RRT and RV-RRT employ a steering 
function, dRRT relies on an oracle that can efficiently query 
for neighbors in the precomputed tiling roadmap. We use 
the Euclidean metric for distance measurement and nearest- 
neighbor search. Specifically, every configuration is treated 
as a point in which represents the coordinates of the m 
anchor points. Nearest-neighbor search is performed using 
ELANN pT) and collision detection is done using a 2D 
adaptation of PQP pS) . All experiments were run on a laptop 
with 2.8GHz Intel Core i7 processor with 8GB of memory. 


A. Test scenarios 


We experimented with three types of multi-link robots 
in a planar environment with polygonal obstacles: free- 
flying open chains, free-flying closed chains, and anchored 
open chains. 

The first type of robots requires primitive operations 
(sampling and local planning) that are straightforward to 
implement. Eor such cases, RRT is the most suitable algo¬ 
rithm to compare with TR-dRRT. Sample configurations for 
RRT and TR-dRRT were generated in a uniform fashion, and 
local planning was done by selecting one anchor point and 
performing interpolation between the angles of the joints, 
while maintaining the anchor point in a fixed position. The 
scenarios used to compare the two algorithms for the first 
type of robots are shown in Eig. In the Tight scenario 

(Fig. la I, a robot with nine links navigates in tight quarters 
among obstacles. The Coiled scenario (Fig. [H depicts a 
robot with ten links which needs to uncoil itself. This 
represents a scenario where the majority of the collisions 
that occur are self collision. In the Bricks scenario (Fig. Ici 
a small 13-linked robot needs to move from a start config¬ 
uration with little clearance to the goal. Note that the figure 
depicts a closed-chain robot as the same scenario is used for 
different robot types. The robot used in the open-chain case 
is identical to the closed chain, except that one of the links 
is removed. 

The second type of robots are free-flying closed chains, 
which are significantly more complex to deal with, as the 
set of collision-free configurations lie on a low-dimensional 
manifold. RV-RRT pO) is arguably the most suitable algo¬ 
rithm for this type of robots. In these settings, TR-dRRT 
uses the primitive operations of RV-RRT for sampling and 


local planning. We use a robot with 12 links and evaluate 
the two algorithms on the Tight (Fig and Bricks (Fig 
scenarios. For TR-dRRT the same preprocessed roadmap was 
used to answer the queries for the different scenarios, as we 
use the same robot (see Fig. [^. 

The third type of robot is an open chain with one of its 
joints permanently anchored to a fixed point in the plane. 
Here we make a first step toward applying TR-dRRT to 
anchored robot arms. In the Gripper scenario (FigfTd)i, a 
10 -link robot is anchored at its middle joint and both of 
the robot’s endpoints need to reach the goal region. This 
simulates two robotic arms that need to grasp an object. We 
constructed one base roadmap representing configurations 
where the middle joint is anchored. Currently, it is not clear 
how to extend the tiling-roadmap concept to the case of 
anchored robots (see discussion in Section |VIII| l. Thus, we 
resort to dense sampling in the preprocessing stage. In the 
query stage, this roadmap was traversed using dRRT. We 
note that more suitable algorithms to solve this problem 
might exist. However, the simple approach described here, 
which outperforms RRT, serves as a proof of concept for the 
applicability of our technique to anchored-robot settings as 
well. 

B. Experiments 

We first study the affect that the number of sampled base 
configurations n has on the query time of TR-dRRT. We then 
proceed to compare the performance of TR-dRRT with RRT 
and RV-RRT. 

TR-dRRT Preprocessing time. For each robot type, we 
gradually increased n. For each such value, we constructed 
the tiling roadmap with k nearest neighbor^ Finally, each 
roadmap was used to solve the aforementioned scenarios. 
Fig. reports on the results for the open-chain nine-link 
robot used in the Tight scenario and the closed-chain robot 
used in the Bricks scenario. The reported preprocessing times 
are averaged over five different tiling roadmaps and the query 
times are averaged over 100 different queries, for each n. Not 
surprisingly, as n grows, the preprocessing times increase 
while the query times decrease: As the number of base 
configurations increases, each base roadmap captures more 
accurately the configuration space of the robot anchored to 
the respective joint. This leads to a better representation 
of iF using Q. Interestingly, for both cases reported, there 
exists a threshold for which the reduction of query times 
is insignificant and comes at the cost of exceedingly-large 
preprocessing times. Similar results were obtained for the 
other robot types. 

Comparison with RRT and RV-RRT. In this set of 
experiments we compare the query time of TR-dRRT with 
RRT or RV-RRT for the aforementioned test scenarios. 
In these experiments TR-dRRT employs the most dense 
precomputed base roadmaps (see above). We mention that we 

^We set k = 2elogn in order to reduce the number of parameters 
involved in the experiments. Such a number of neighbors can lead to 
asymptotic optimality of sampling-based motion-planning algorithms in 
certain situations (see, j^), although we do not make such a claim here. 










(a) Tight (b) Bricks CC 

Fig. 6. Quality of results as a function of preprocessing times. Query time tq (left y-axis) and preprocessing time tp (right y-axis) as a function of 
the number n of base configurations for the open-chain nine-link robot in the Tight scenario (a) and the closed chain robot used in the Bricks scenario 
(b). Error bars denote one standard deviation. Size of the tiling roadmap after preprocessing is added (only partial values are given to avoid cluttering the 
graph). 


are not concerned with the quality of the solution, and only 
measure the time required to answer a query successfully. 
The preprocessing times for constructing the tiling roadmaps 
for the open-chain robots (Fig. 1-3) are fairly low (up to 
three minutes). For the Gripper scenario, we had to apply 
longer preprocessing times (roughly ten minutes) in order to 
construct a dense roadmap. For the closed-chain scenarios, 
preprocessing times were in the order of several hours. We 
note, however, that even fairly moderate preprocessing times 
could have obtained almost the same speedups (see Fig. |^. 
For the open-chain robots, both in the Tight and in the 
Coiled scenarios, TR-dRRT is roughly ten times faster than 
the RRT algorithm, while in the Bricks scenario, TR-dRRT 
is roughly five times faster than the RRT algorithm. For 
the Gripper scenario, TR-dRRT is roughly twice as fast as 
the RRT algorithm. In more complex problems with closed- 
chain robots TR-dRRT is roughly more than fifty times faster 
than RV-RRT, which is arguably the state-of-the-art for such 
problems. 

VIII. Discussion and future work 

This paper introduces a new paradigm in sampling-based 
motion-planning in which the specific structure of the robot 
is taken into consideration to reduce the amount of self¬ 
collision checks one has to perform online. We demonstrate 
this paradigm using the TR-dRRT algorithm which is de¬ 
signed for free-flying multi-link robots. TR-dRRT performs 
a preprocessing stage, which results in an implicit tiling 
roadmap that represents an infinite set of configurations and 
transitions which are entirely self-collision free. Given a 
query, the search of the configuration space is restricted to 
the tiling roadmap. As a result, no self-collision checks need 
to be performed, and the query stage is dedicated exclusively 
to finding an obstacle-collision free path. 

We note that the preprocessing stage can be performed 
on stronger machinery, e.g., using cloud computing, than the 



Scenario 

Fig. 7. Running times in seconds for the TR-dRRT (blue), RRT (green), 
and RV-RRT (red) algorithms (ten different runs), given as box plots: Lower 
and upper horizontal segments represent minimal and maximal running 
times, respectively; The diamond represents the average running time; The 
line in the middle of each box is the median, and the top and bottom of 
each box represent the 75th and 25th percentile, respectively. CC denotes 
that a closed-chain robot was used in the scenario. Notice that the time axis 
is in log scale. 

one available to the robot in the query stage. Moreover, the 
preprocessing stage may easily be sped up by computing the 
individual base roadmaps in parallel. 

To conclude, we point out an additional benefit of the TR- 
dRRT framework and suggest a direction for future research. 

Reducing interpolation costs. Our framework can be used 
not only to eliminate self-collision checks, but also to reduce 
the cost of computing local plans (interpolations between 
two configurations) during the query stage. The cost of 
computing a local plan becomes significant when the number 
of degrees of freedom of the robot is high or when the 
robot has closed chains. As the base roadmaps specify which 
local plans can be used in the query stage, such plans 
can be precomputed and stored for every edge of the base 
roadmaps. Moreover, every local plan can be represented in 






































a structure that can reduce the running time of obstacle- 
collision checks. For instance, in our implementation we 
represent every local plan as a polygon that bounds the swept 
are^of the respective motion. In particular, for every edge 
of a base roadmap (but not the tiling roadmap) we generate 
the swept area of the respective robot motion and generate a 
polygon which approximates the boundary of the swept area. 
This allows to perform a single obstacle-collision check for a 
given local plan, rather than densely sampling configurations 
along the motion and testing individually each and every 
configuration for collision. Specifically, whenever an edge of 
the tiling roadmap needs to be tested for obstacle collision 
during the query stage, the polygon which corresponds to 
the base-roadmap edge is extracted, translated according to 
the translation of the tiling roadmap edge, and tested for 
collision with the obstacles. 

Recursive TR-dRRT. Although the experimental results 
are promising, TR-dRRT has its limitations. The explicitly- 
represented base roadmaps should accurately capture the 
self-collision free spaces for which one of the anchor points 
of the robot is fixed. For a robot with D degrees of freedom 
moving in this space is {D — (i)-dimensional. Clearly, 
the favorable characteristics of our approach diminish as D 
increases. To overcome the so-called “curse of dimension¬ 
ality” for this specific type of robots, we believe that one 
can apply our technique in a recursive manner. For instance, 
assume that the self-collision free space of a “snake-like” 
robot with m — 1 links (or m anchor points) can be captured 
by a roadmap accurately and efficiently. Now, given a robot 
with 2m — 2 links, it can be decomposed into two parts, 
consisting of m — 1 links each. Then one can generate a 
tiling roadmap for each of the two parts and combine the two 
roadmaps into one, which, in turn, provides a covering of the 
entire self-collision free space. This bears resemblance to ex¬ 
isting methods which recursively use copies of precomputed 
subspaces in motion-planning algorithms | [49) or iteratively 
solve increasingly difficult relaxations of the given motion¬ 
planning problem | [5m , both of which have been shown as 
effective tools to enhance motion-planning algorithms. 
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